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SERVO LOOP PID COMPENSATOR WITH EMBEDDED RATE LIMIT 

Martin A. Wand 



TECHNICAL FIELD OF THE INVENTION 

The technical field of this invention is feedback control 
systems employing proportional, integral and differential 
compensation. 

BACKGROUND OF THE INVENTION 

Feedback control systems, also known as servomechanisms 
or servo devices have been developed using a wide variety of 
technologies and techniques. These systems have a broad 
spectrum of applications. Many special types of servos are 
used in high performance equipment. A special type of servo 
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loop acting to achieve proportional, integral and differential 
(PID) compensation is often used to processes an error signal 
and generate a command. The goal of this loop is to generate 
the proper command to ultimately drive the error signal to 
zero. The command generated by the PID compensator consists 
of three components. 

1. The component proportional to the error (proportional 

P) . 

2. The component proportional to the cumulative sum of 
the error (integral I) . 

3. The component proportional to the rate of change of 
the error (derivative D) . 

Consider the case where the error is a position error. 
The task of the PID compensator is to drive the servomechanism 
to a commanded position, thus reducing the position error to 
zero. The design of the proper PID compensator is well-known 
to practitioners in the field of control systems and the 
details of such design approaches are not the major focus of 
this invention. Conventional design techniques assure that 
the design is stable with appropriate stability margins. 
Digital servos are increasingly common because they are very 
effective due to development in recent years. 

When a design is implemented considerations must be given 
to factors such as mechanical, electrical and timing limits. 
These limits may be exceeded if the mechanism moves too 
quickly. An example is when the compensator generates a 
command to a very fast actuator and the loop must have a large 
bandwidth to hold the position in the presence of high 
frequency disturbances. Such devices work well when the 
position error is small and all techniques have been brought 
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to bear to overcome these disturbances. Consider, what 
happens when a new position command is. issued. The position 
error is very large resulting in an extremely large component 
of proportional correction signal. This results in a large 
correction command given to the actuator driver that tends to 
cause correction. The integral component also begins changing 
but its effect is not as immediate. The derivative component 
is an impulse because the rate of change of the position error 
is large. In a prior art design a high performance actuator 
can quickly reach high speeds. 

Figure 1 illustrates the components of a prior art PID 
compensator. The control equations are easily recognized in 
Figure' 1. The input signal is position error 100. The output 
signal is torque command 110. The proportional signal couples 
position error 100 to summing junction 103. The integrate 
signal comes from integration block 101 and the modifying gain 
constant factor Wi in amplifier block 102. The signal 
operation comes from derivative block 105, the modifying gain 
constant factor I/W2 in amplifier block 106, low pass filter 
107 having a cutoff frequency of W3 and low pass filter 108 
having a cutoff frequency of W4. The transfer function 
frequency characteristics are shaped at low frequencies 
through parameters Wi and W2 and by parameters W3 and W4 at 
high frequency. 

There is need to introduce a moderating factor in the 
servo operation to prevent unwarranted over-drive of the high 
performance actuator. The PID compensator of Figure 1 may be 
described mathematically by transfer function equation [1] 
which omits W3 and W4 for simplicity: 
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Figure 2 illustrates a piece-wise graphical 
representation of the PID compensator of Figure 1 and Equation 
1 with an arbitrary overall gain. The integral portion 200 
removes low frequency offsets (DC bias) and the derivative 
portion 207 provides fast response to high frequency 
disturbances. The proportional portion 205 bridges the 
integral and derivative regions. Figure 2 also illustrates 
the derivative poles, W3 203 and W4 204 for the typical PID 
compensator illustrated in Figure 1. In Figure 2, the lower 
frequency break points Wi 201 and W2 202 of the transfer 
function versus frequency are introduced by the frequency 
responses of respective amplification stages 102 and 106. 
Since the differentiator is the dominant component at 
frequencies above W2 202, the poles W3 203 and W4 204 can be 
included in the implementation without affecting the validity 
of the approaches to be described here. 

SUMMARY OF THE INVENTION 

This invention describes a reconfigured form of the well 
known proportional, integral, differential (PID) servo 
compensator. The reconfiguration provides inherent limits on 
the rate of change of the position error without affecting the 
performance of the servo loop when the position error is 
small. The technique maintains the high-performance of 
current PID servo compensators when the position error is 
close to zero, the operating point of primary interest. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

These and other aspects of this invention are illustrated 
in the drawings, in which: 

Figure 1 illustrates a functional block diagram of a PID 
servo compensator of the prior art; 

Figure 2 illustrates the log gain versus frequency 
characteristic of the PID servo compensator illustrated in 
Figure 1; 

Figure 3 illustrates the functional block diagram of a 

modified PID servo compensator with explicit rate limit of 

this inventions- 
Figure 4 illustrates the functional block diagram of the 

PID servo compensator of this invention with embedded rate 

limit; and 

Figure 5 illustrates the log gain versus frequency 
characteristic of the servo PID compensator with embedded rate 
limit of this invention. 

DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS 

This invention recognizes an important principle. An 
alternate form of PID servo compensator providing rate 
limiting is desirable. This invention permits computations of 
the rate command based on the position error so that the rate 
command could be limited. Figure 3 illustrates one possible 
approach. Equation 2 below is the corresponding transfer 
function. The three forward paths of Figure 1 are modified in 
Figure 3 to form the four forward paths of Figure 3. This 
gives the same functional features while including a rate 
limiting block 306. Derivative block 301 forms the derivative 
term. Gain block 302 controls the derivative gain. Similarly, 
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gain block 305, integrator 308 and integral gain block 309 
implement the integral term. The proportional factor is 
implemented through two paths in Figure 3. These two paths 
use: derivative block 301, integrator 308, and integral block 
309 for one path; and gain blocks 305 and 302 for the other 
path. These two paths sum to equal the cumulative proportional 
effect. Summing junction 303 forms the torque command 310. 

Employing the principle of superposition since these are 
linear networks, the overall transfer function can be derived 
by inspection in terms of the four forward paths. In 
operational mathematics notation, Equation 2 represents 
mathematically the transfer functional of the block diagram of 
Figure* 3. For simplicity and conciseness in describing the 
techniques of the invention, the differentiator poles, W3 203 
and W4 204, are omitted at this point from Figure 3 though 
these differentiator poles must be accounted for in the final 
implementation . 



The block diagram of Figure 3 includes a computed rate command 
factor that can be limited and an integrator that can be 
limited and reset to prevent windup. 

Equating the coefficients of the PID terms in Equation 1 
and Equation 2 yields three equations in three unknowns, 
illustrated in Equations 3. 
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= 1 
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Solving Equation 3 for K„ K„ and Ki in terms of Wi and can 
yield oomplex numbers. This form is thus not always realizable 

in hardware. 

Another path or paths must be added in the controller of 
Figure 3 to insure it is realizable. Figure 4 illustrates 
such an embodiment of the servo compensator. This is similar 
to the servo compensator of Figure 3 with changes to the path 
for the computed rate and an additional proportional path with 
limit to the output. Figure 4 also includes slight changes in 
the gain blocks. The gain after the last summing junction Kc 
normalizes the compensator gain to match the gain of the 
original compensator of Figure 3. 

Equation 4 shows the transfer function for the 
compensator of Figure 4. The limit blocks are ignored for 
now. The differentiator poles, W3 203 and W. 204, are omitted 
from Figure 4 though these differentiator poles must be 
included in the final implementation. 
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Equating the coefficients as before yields three equations 
with four unknowns: 



K(.xK,fXK, =vi'[ 



[51 



Equations 5 have more than one solution because there are 
four unknowns. Solving for Ki results in a quadratic. 



l±^l-4xi^xwi 



[6] 



The value of Kc can be selected such that the quadratic term 
of Equation 6 is zero, guaranteeing a single real value for 
Ki. This becomes the fourth equation in the solution. The 
results of the four equations are shown in Equation 7. These 
coefficients yield the same closed loop results as the 
original form of Equation 1. 
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Now the rate limit can be applied. Note that the conimanded 
rate goes to two different limit blocks 406 and 411. When the 
position error is large and the measured rate equals the 
desired rate in steady state operation (constant slew rate) , a 
constant output that counteracts friction or any torque 
offsets such as gravity or springs is desirable. Of course 
the output is not truly constant, since the spring torque may 
change as the actuator moves but that is why the loop is 
closed. This constant output should come from the integrator. 
By setting rate_limit_2 to the desired rate, the integrator 
input becomes zero. Thus the integrator output is 
instantaneously constant. Setting rate_limit_l equal to the 
desired rate times Kd, the other paths contribute nothing to 
the output in this particular steady state condition. 

What do the two limits do to the stability and 
performance of the servo loop? The condition where neither 
limit is reached is identical to the original design that was 
stable by design. When the position error is mid-range where 
the position error exceeds rate_limit_2 but not rate_limit_l, 
the limit has the same effect as reducing Kr to Kr' such that 
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[KRxposition_error] = rate_limit_2 . In Equation 5, this 
reduction of Kr only affects the integral coefficient so that 
now KcxKr'xKi = Wi. So reducing Kr has the effect of reducing 
Wi. This reduces the effect of the integrator by reducing the 
frequency where the integrator ends. In the process, it 
reduces the gain of all frequencies up to the original Wi. 
Figure 5 shows this graphically. Below rate_limit_2 the curve 
500 is applicable. Above rate_limit_2 but below rate_limit_l, 
the curve 511 is applicable. Finally above rate_limit_l, the 
curve 512 is applicable. 

Assuming that the crossover frequencies where the gain 
and phase margins are recorded are sufficiently higher than 
Wi, the reduction of Wi has little effect on the stability of 
the controller. This is in fact the very type of servo that 
this invention is useful for, where the servo has a high 
bandwidth . 

When the position error is large and exceeds both 
rate_limit_2 and rate_limit_l, the effect is similar to a 
reduction in Kr for both paths. As before, refer to the 
reduced gain of the integral path as Kr' . Because 
rate limit_l equals rate_limit_2xKD, the equivalent Kr for that 

path is Kr'xKd. 

Note from equation 5 that the derivative term is still 
not affected by the limits. Both the proportional and 
integral paths are affected. The frequency where the integral 
region ends continues to decrease and the gain of the 
proportional region decreases as the position error increases. 
Figure 5 shows this graphically. In the region 506 the 
derivative term remain unaffected by rate limits. In the 
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region 505 the proportional term gain is decreased with lower 
corner frequency also reduced to 509 or 513, upon exceeding 
rate_limit_2 and rate_lirait_l respectively. In the region 500 
the integral term remains on the original curve 500 for small 
error but shifts to 511 when the position error exceeds 
rate_limit_2 and shift to curve 512 when the position error 
exceeds rate_limit_l . 

Figure 5 illustrates curves 500, 511 and 512 separately 
whereas they actually represent three distinct operating 
points. The integral portion of the response transitions 
smoothly from curve 500 to the left as the position error 
increases. For example, when position error equals 
rate_rimit_2, curves 500 and 511 are identical. 

As before, this has little effect on the higher 
frequencies so it has little effect on the stability of the 
controller. The exact effect of the limits on the stability 
of the servo can be analyzed if desired. 

The two derivative low pass filters with respective cut 
off frequencies of W3 and W4 are provided in the derivative 
path following derivative block 401 in a manner similar to 
that illustrated in Figure 1. 

There are many ways to configure a PID compensator but no 
implementation that is the same as described in this 
invention. Other common ways to accomplish rate control or a 
position servo are listed below. 

1 . The position command can be ramped to the desired 
position as the actuator moves causing the rate to be 
controlled. The ramp rate of the position command will 
determine the achieved rate. This is not always 
straightforward, since in some servo systems, the position 
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command does not explicitly exist. Only the position error 
may be available, as is often the case when all positioning is 
relative instead of absolute. 

2. The position error can be limited prior to the PID 
compensator. The problem with this type of implementation is 
that the derivative term is effectively removed from the 
compensator while the position error exceeds the limit because 
the position error into the PID compensator remains constant 
until it is less than the limit. There is no apparent motion. 
Also, the integral term must be limited because it will windup 
during the entire move. 

3. A separate rate loop can be designed to handle the 
move then the controller can switch to the PID compensator as 
the position error approaches zero. This requires design of 
two separate loops and care must be exercised during the 
switchover to prevent glitches in the command. Such a rate 
loop also needs some sort of profile control to slow down the 
actuator prior to the switchover. This method might be 
preferable over the method described in this disclosure when 
very precise control of the rate is required. 

Advantages of the Invention 

1. Maintains the stability performance of the traditional 
PID compensator design. 

2. Controls the rate of the servo while maintaining the 
effect of a PID compensator during the entire move. 

3. Does not require the design of multiple compensators 
for different operating modes. 

4. If one considers the two limits within the loop as 
representing different operating modes, the switch between 
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modes is automatic, inherently glitch-free and no special 
considerations are required to handle the transitions. 

5. This technique can be applied in both digital and 
analog implementations since it is not a multi-mode controller 
requiring sophisticated mode control. 

This invention is usable in any servo that meets the 
criteria of high bandwidth, fast actuator and required rate 
limit during moves. 
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